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I . introduction 

A. Importance of flexible arm control to robotics. 

Today's manipulator system*', are really quite crude. They 
tend to be massive and ponderous,:, lln Industrial applications, 
manipulators weighing tons are required to transport and position 
parts and tools weighing a few pounds. They arc, therefore, 
costly in the materials used to make them, the space they take up, 
the power they consume, and the time they require to do simple 
operations. 

The Space Shuttle manipulator will have to be operated manually 
and very slowly. 

To date, the growing computer power available has been used 
to handle kinematic relations of increasing complexity. But; 
problems of dynamics and flexibility have been solved by making 
the members extremely stiff. As we become able to develop 
control techniques that tolerate rlexibility in a manipulator’s 
mechanical structure, the use of such flexible arms will have 
many desirable consequences: manipulators can be lighter and 

faster, safer to use, and less prone to damage from collisions. 
They will also require less power to run and cost less to con- 
struct. They will be essential to the objective of automating 
the tasks of the large, flexible manipulator arras of the Space 
Shuttle. Finally, these same control strategies will be Important 
for the control of such flexible space structures as very large 
antennas: large' space systems planned for the 1980’s and beyond 

will require significant advances over today’s technology. 

Another characteristic of today's manipulators is that they 
effect position control by "dead reckoning": the computer is 

told the coordinates of the desired position, and the manipulator 



system is moved by controlling the angle of each link relative 
to the previous one. Position accuracy is thus only as good as 
the accumulation of errors and the stiffness of the members, and 
of the base on which everything sits. The astute use of end-point 
sensins and feedback will make possible a new level of precision 

in manipulator use, and open up many new areas for manipulator 

» , 

application. for space applications — where the "base M is 

empty space, the manipulator links are highly flexible, and the' 

* » 

penalty for inaccuracy may be either painfully slow operation 
or destruction of delicate space systems — sophisticated 
end-point feedback will be an essential element. 

A third very important problem that limits the capability 
of present manipulators is the fact that there are large and 

► / ... H#?' ' ' * 




rapid changes can occur in the inertia properties of -tire system being 
controlled as it changes conf igura t ion , and particularly when it 
picks up massive loads. Precise control of a system having large 
time variation in its parameters is a particularly nasty problem. 
If constant control "gains'* are used the system response will 
necessarily vary from very sluggish to nearly unstable. If a 
scheme of total adaption is used, an essential nonlinearity is 
introduced which makes the control algorithm extremely complex. 

Our recent work in the areas of optimal control with uncertain 
parameters and plant identification pleads us to believe 

the best control strategy for the manipulator control problem 
will be a combination of adaptation by regime and robust optimal 
control within regimes. (This also will introduce some challeng- 


ing switching 


problems; but the tradeoff appears favorable.) 
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B . Long-term goals. 

What we propose to do together in the present project is to 
bring to bear (i) experience with dynamics and control of flexible 
structural members, (2) end-point sensing techniques, and (3) 
advanced concepts for robust control of systems whose parameters 
are uncertain and changing, to demonstrate good control of a 
single, very flexible member in a plane. Then a mass of unknown 
size ''object to be carried) will be added at the end of the arm, 
so that the controller must infer the new dynamic character of the 
system quickly enough to accomplish fast, efficient transport to 
a commanded location, and precise final positioning. 


C . Initial objectives for this contract . 

a. Develop and analyze exact equations of motion of an arm 
with known parameters preparatory to designing control systems 
for same. 

b. Design an experimental one-link arm for testing control 
designs. 
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111. ANALYSIS OF A CONTROLLABLE FLEXIBLE ROBOT AR M. 

A. Modal equations. 

The goal is to describe the motion of the arm by a set of , 

first order differential equations in the following manner: 

1 * 

x ** Fx + Gu 
(I) 

y ' ** llx 
. s 

V • • • 

X is the state vector x « q ^ , q , q ^ > q ^ , q ^ , q ^ » . . . . where q fl 
describes the rigid body mode 

q^, i,> l describes the i~th flexible mode 

u is the control torque 

y Is a vector made ud of the 3 outputs of the 3 sensors 
s 

mounted on the beam 

The rationale for such a formulation (I) is that it is the most 
convenient form for using modern control design techniques, 
i . Development of the equations of motion . 

The model for the arm is a uniform beam of length l % density 
p , width b and thickness t and elasticity modulus E with a 
lumped inertia at its hub 1^ . 



FIG. 1. 
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Tli 0 equations are obtained from the angular momentum theorem and 
Hamilton's principle. 

From angular momentum theorem: 

* 

^ ^ eft; * ^ uhereh«|y (om x v)dm | + 1^0 

C») 

• ( • 

we have v ■ — <n0 3^ 4- (m + x0)3T 

r\ • , * 

so h *» J (xw + x 2 0 ) dm + I,,0 after neglecting <u z 0 

o 


From (1) we get: 
( 2 ) 


j xvl a-m + (i 6+ i H )e - T 


From Hamilton's principle: 

(3) Sf^Ldu') «* 0 where L is the lagrangian of the arm; 

\ 

and are virtual displacements which are 0 at t^ adn t£* 

Xf we call y : y « w + xQ y can be large as the angle 0 becomes 
large; w retaains small. 

The Lagrangian L - T' k - V is made up of 2 terms: 

~ kinetic energy - 

£ 

(4) 0** -4* J after neglecting 

the centrif ugical term ui l 0 

- potential energy V - 

(5) = f W&fAK'-'TB 

This expression is valid if ^VL and ?u remain small 

** <>& 


(Euler~Bernowilli beam) 

After many manipulations on (3) with (4) and (5) we get a 4tfa 
order PDE describing the beam. 



( 6 ) 
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bi % ' < % - ° 


Er +. T = I„e 

y («) = o 



Note that the 1st equation could bo written in terras of the 

small quantity w: ET , a - _ px© 

5X4 ▼ V ^ > 

(2) and (6) describe completely the dynamics of a uniform one 


link arm. 
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11 . Natural modes of the arm : 

In order to get the natural frequencies and mode shapes of 
the arm we set the control torque T to zero in (6) and write 
y(x,t) « <(>(x)q(t) where q(t) *» e 

(6) can be written as:' * 


s ° 

ei ific) = (f) 

( o) ~ o 

<js=Cd\ = ^'°(t )=0 


er 


The solution to (7) is: 

cj> px + •-> ti’Tv ^x + cosk £x v p s\«r»\> Jbx 

The frequencies are solution of the equation: 


where 


- £-?** -fl-t cmei e s T h U 

e-t 


») 


Cos Xi. “* S»m\ CaskXi “ ( \ + CcsXj, <OS.VXfc. ^ s 0 


T U - Ku\j Vnir^n. . 
tj inf>eo\s<*_ 


In order to get the 4 constants A,B,C,D we need to normalize 
the mode shapes: 




Oft) 


' ' = °< V” 


Do) 


? " c 

A numerical program has been written to solve for (9) and CiO) - 

Table i contains four different values of G» the values of 

( V," * tP JLi) and A,B,C,D for the first 4 mode shapes. 

Tx 1 


for the rigid body mode; 
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ill. Modal conations. 


We now proceed to get the set of ODE’s we arc looking for. 

We write the eolation y(x,t) to (6) as: 

= * 5 

We re-write (3) and (4) (including control torque) as: 2L ■* 2T^- 2V 

iL - § [*„ 4>) 4>) Viil + 5 f** 1 *■> *"■ 

- sr £ [ ^ ^ *Mil ** Te 

lining the orthogonality relations, we obtain the relations: 

^ ^ ^( T w* x d) ’|H° * 

Cx r +T 4f A * - ( r H^«) 

6 " 

oo, we get: 

tL-cv^i. 1, +|(v^> s - 1 V* ■* T £v 



Lagrange's equations are: 

= ° 

( h * H ~) S j.-T’ 


C-sO|lj.*» *6 


so : 


V ~£- 

r H+ X D 

w> 


(>o 


Note: (11) is the same type of equation as the one used by Likins 

(see 3PL Report on flexible sjc dynamics.} 


It is possible to include damping: 



Wc write; 


*** 0 ***■ 


H' + ■*** s. „ here s,. «^V) («» 

) l(x ' w s . I* x v + 

the 5^*8 have been computed for different values of e and are 
shown in Table 1, 


iv. Measurement vector y ; 

— — — — ‘-S 

The sensors that will be used to control the arm are a 
potentiometer (6), a tachometer (0), a tip sensor for terminal 
control at the end of the slew maneuver (y(D) and a set of 
strain gages at different locations x ± . 

From (12) we get: 

9 = 1. *• Si V- 
® = i. + ta i l 


where Sj_ are shown in Table 1 


y-r - '-v * 

The strain gages measure the 


where 6^(L) are shown in Table 


strain , at the surface of the beam: 



(14) 
i. O 
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B . Exact: Transfer Functions for a One Link Arm. 

From the dynamics equations developed in A, it is possible 

to obtain any transfer function from the control torque to any 

v 

sensor output y ; but, in order to do that, one has to truncate 

S * 

and keep a finite number of modes. This implies that the- zero 
of the truncated T . F . will not be exact. ' 

Alternatively, a technique shovm by A. Bryson enables one 
t0 exact T.F . for certain simple analytical models (i.e., 

Euler-Bernouilli Beams) . 


i. Transfer function calculation. 

Let’s take the Laplace’s transform of the set of equations 
(6) in A and also change x to x * L “ x: 

“ f .s) + £§- yU , s) — 0 

dx* 1 LI i 

1 

y 33 * (0,s) » y^CO.s) ® 0 (1) 

T + Ely 11 . L , s ®-I H s z y I (l,s) 

y C L » S ) “ 0 

Let’s define 3 3 4 ® 3 is a complex number 


The first equation of (1) is: y 3 ^ (x 1 ,s) - P^yCx'jS) *= 0 

y ( t 1 , s ) ® A sinC&x 1 ) + 3 sinhCEx 1 ) + C cos (3x* ) + D cosh(3x*) 
Using the 4 boundary conditions in (1) we get: A = B ; C = D 


and the following 2x2 linear system: 

sinX + sinhX cosX I- coshX 

-sinX + sinhX - EX 3 (cosX+coshX) -cosX + coshX - 



I H = 
pL 3 


where: X = 3L 


G 


(as in A) 


We solve for this system and get the T.F* y(x^,s)/T: 

_ (eX ^cV-XUsE*' *sW) - (sX+gUAfckX 1 \<V 
T 2 Et (?-[sXcVX -*ua + .X* CWcXcKM 1 

where: c *» cos; s * sin; ch » cosh; sli « sinh 


ii . Application. 

We can get any T.F. of interest for any sensors, 
a) Transfer function 0^/T (potentiometer/ tachometer at hub) 

Note that X* « ^ at hub from x* » L - x 

0 H “ - fL > s> 

S x 1 • 

From (2) we get: 


^ A- , Ucl g^X 

tv V Etg, sXcU-sUd+e&CUeXcU) 


A is a complex number here: A 4 = ~ V TT 




El 


«.* . 

a > 


s « 


the numerator or the denominator 


can be expanded as: 

• I + cXcU * I# (U S ^) 

sAcU - S UA + G X 3 (w c.V c U1 = i/jX^uxu'j |(i* *f u i ) 

i _ ^ i .... . _■ „ a .. .. 


Finally, we get: 


. o^K'+^y 


0U _ _i 


This transfer function is of very general application for 




If one excites the arm at the frequency of one of the zeros 

(w , ) there will be no motion of the hub; of course, we have to 
c % 

include damping for real cases, so there will be small motion. 
This fact has been checked experimentally. 

Note also that the zeros correspond to a cantilivered beam 
(1 h cXchX « 0 is the well known equation for the frequencies of 
a cantilivered beam) ; the poles are for a pinned beam (.if one 
sac 0, sXchX « shXcX is also well known to be for the pinned 
beam) . 

FIG. 1. shows the poles/zeros location for the* model of the 
experimental beam. 

It can be seen that for e>0.02 from the third/ mode, poles 
and zeros cancelled each other. 


so 


B. Transfer Function y^/T (.tip sensor) 
From (2) : y ^ » y^Cx^O) 


y T /T(s) « 


1 sX h shl 

EI$ 2 sXchX - shXcX h eX 3 (l+cXchX) 


, numerator and denominator can 


be expanded so that one gets the ex *ssion: 



- J 

(V T »)s* 








The configuration is: 


Ume* 


■* 




FIG. 2. shows the configuration for the model of the exper- 
imental arm. It has been checked experimentally that there are 
no zeros on the jto axis; it seems difficult to verify in o pen loop 
the (real axis) location of the zeros. 

The zeros have been computed numerically: 

X i « 2.365, 5,498* 5,498 + kir/ k>2 


Then we get: 



EX ^ 

pL 1 ' 1 1 


Conclusion . .. 

We get a tool to design controllers for the arts using the 
root locus method and without having to bother with truncation 
errors. Note that it has been possible only because we have a 
very simple model: it cannot be applied to complicated structures. 
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I II . DESIGN OF EXPERIMENTAL APPARATUS . 

Subsequent to the contract work reported here, a one link 
robot arm has been designed and built (under separate funding) 
by Moohe Tkacss, PhD candidate in the Department of Aeronautics & 
Astronautics. The main problem to solve for the design of a 
very flexible arm is to make it rigid in torsion; if one uses a 
simple beam of 1 meter long, when the beam bends, the tip part of 
the beam deflects in torsion* For decoupling of bending and 
torsion, the arm is made of 2 parallel beams connected together 
with 5 bridges; these bridges act as pinned joints for the 
bending of the 2 beams, and prevent any torsion of the arm. 
Picture 1 explains the arrangement: 



Experimental arm (top view) 


Picture l : 


A . Arm Characteristics. 
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Below ‘is the main data for the arm: 

Beams mass: 2 x 6.5oz. » 373.6 g. (I2gr) 

Bridges mass: 5 x 10 oz. = 141.5 g. (made of beryliuro + Alu) 
Bridge nass/Beara mass » .38 


Yearns moment of inertia at hub .142 Kgm' 


Bridges moment of inertia at hub - .052 Kgm 

2 

_ a <a r* * w» *’• 


Total arta moment of inertia 1^ « .194 Kgm 


-4 2 

Clamping device moment of inertia (.hub) = 3.4 10 Kgm 


Added inertia at the hub: 


.02 Kgm' 


Total hub inertia (including DC motor rotor & tachorotor) = .021 Kg 

X H 

Ratio E (see II) : e “ Yt~ ' m '03 6 —>.04 

B 


Elasticity modulus: F. ~ 7 10 SI 


Area moment of inertia: I 


3 . - £ 4 

^ > r," “ 


El -•= .29 6 Nm‘ 
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B * Actuator Characteristics. 

It’s a MAGTECH 300 ozln peak torque DC servomotor* The 
main test performed on the motor is described in the next figure. 





From t h i s teat, it was found that the back emf constant* 

is « .26 Nm/A, It is the nominal value from the spec sheets. 

The theory says that the torque constant K„ and the constant K D 

i IS 

are equal: K^Os’m/A) « K^(V/Rd/s) so K^, ** .26 Nm/A or 

K,j, » 3 7,2 ozin/A. 

A direct measurement of K^, should be performed in the future. 

Note that K tJ , is essential for a control design (gains). Also, 

K 

a model of the actuator might be needed in the future * 

C . Power Amplifier. 

The PA enables one to have a current-drive DC motor, so that 
one can write: Torque — K^, x Amperage. 

The gain of the PA has been measured: Kp^ *= 0.81 A/V. 

The dynamic model for the PA will be obtained. 

D . Tachometer . 

Tire tachometer is a DC motor (MAGFLEX) . 

The gain has been measured K^, a =* .06V/Rd/s. 
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This is a Bourns single-turn film 20K. potentiometer. 


The gain is K pQT “ A. 77 V/Rd. A new potentiometer is on order 
because of the very noisy signal of the current one. 


F . End Point Sensor. 

This is a United Technology dual axis position sensor which 
provides x and y axis position of a light spot on the detector 
surface. One AC line-powered amplifier is used for each channel. 
The. amplifiers provide 2 output voltages corresponding to flic, 
sum (light-intensity) and to the. difference (position) of the 
2 input currents. 

A divider network is added to obtain a voltate directly 
proportioned to the position. 

The light bulb has been mounted on the tip of one of the 2 
beams. A lens of 22mm focal length focuses the image of the 
light bulb on the detector Itself. 

The gain of the tip sensor is: 

K_, » .7 V/ in with divider noise level .IV 

i s 

K - .06 V/in without divider noise level .008V 

1 s 

Note that the sensor picks up all the ambient light and one 
needs to work in a dark environment for better results. 


G . Strain Gages. 

Two strain gages have been mounted at 19 in. from the hub on 
two sides of one beam; with two strain gages, one gets rid of. the 
temperature effects. 



\ 
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Thc spec, for the gage itself is: K « 120^t*5% 

gage factor K *» 2.1t*5% 

A CAhEX bridge sensor is used as an amplifier and also to 
provide a regulated power supply for the wheastone bridge used for 
signal detection. 

Currently, the setup is working with one strain gage put in 
the wheastone bridge. Calibration tests will be done and also 
frequency response tests will be done in open loop to check the 
validity of the analytical model. 

Conclusion . 

Many sensors are now availab-te for control purposes. This 
implies that w c will be able to be relatively immune to errors 
between the model and the actual plant. 

We will also add variable low pass filters to get rid of the 
high frequency noise generated by all these sensors. 
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IV. A RETORT ON' WORK DONE SUBSEQUENT TO THIS CONT R ACT. 

The apparatus described in Section III was subsequently built 
under separate funding. 

The arm's natural frequencies have been measured for comparison 

with the analysis of Section II: this has been done by recording 

the gain curve of the transfer function Ojj/'f, where 0 ^ is the output 

:* 

of the potentiometer. The analytical model yields nn expression: 


0 H i (s 2 /g> 2 +1) (s 2 /(d 2 +1) • • • 

T <*f H +I B )s 2 (aVR**H> (s 2 /&5+l) * • • 

A constant amplified sinusoidal signal has been input Lo the 
entry point of the power amplifier. The output of the potentiometer 

was recorded on the oscilloscope. The frequency of the input , 

* * * 

signal was varied from .2 to 10 Hz..* The zeros of the T.F. are the 
ones for which the output of the potentiometer is a local 
minimum while the poles are the ones for which it is a local 

maximum. Table 1 gives the comparison between experimental and 

theoretical values. The first theoretical zero was assigned 
the experimental value (first bending frequency of the arm 
clamped) . 


zeros 

theoretical 

experimental 


.68 

CO 

» 


4.25 

3 .7 


poles 

theoretical 

i 

experimental 


1 .83 

1 .9 


4.74 

4.2 


values 
arc in 
Hz 


Table 1 
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Cloyed coop control has been successfully achieved using 

the tachometer and the tip sensor only. The controller has 

been designed by root locus techniques; from the analysis done in 

XX, it is easy to close the loop on the tachometer (rate): a 

simple gain is needed to stabilize the flexible poles. Figures 

l and 2 show the root locus then with the closed loop poles from 

the rate loop; the tip sensor loop is closed with a load-lag 

network. Figures 3 and 4 show the root loci for 2 networks: 

T „ _ k Y t •= -k !s±§L-. v 

1 K (s+30) y T ’ 1 (s+30) y T 

The control ciscussed above was implemented in analog 
electronics with very acceptable results . This 
control has limited bandwidth. 

Research is now proceeding toward the long term objective 
described in Section I. It: is believed that a control of high 
bandwidth can be achieved using the strain gages in addition to 
the other sensors. Also, more work needs to be cone fox* the 
design of a command follower controller which can successfully 
slew the arm in a minimum amount of time. 

A MINC IX computer (PPP1103) has been acquired recently which 
will allow us to implement any sophisticated controller much more 
easily than with analog electronics. 


